#geometry_msgs/Pose[] poses     #路径点集
tr_msgs/WayPoint[] points